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Abstract 


In  target  tracking  applications,  there  may  be  situations  where  measurements  from  a  given 
target  arrive  out  of  sequence  at  the  processing  center.  This  problem  is  commonly  referred  to 
as  Out-of-Sequence  Measurements  (OOSMs).  So  far,  most  of  the  existing  solutions  to  this 
problem  are  based  on  retrodiction,  where  backward  prediction  of  the  current  estimated  state 
is  used  to  incorporate  the  OOSMs  at  appropriate  time  instants.  This  document  suggests 
a  new  method  for  tackling  the  OOSMs  problem  without  backward  prediction.  Based  on  a 
forward  prediction  and  decorrelation  approach,  the  method  has  proved  to  compare  favorably 
to  the  best  retrodiction-based  methods,  while  requiring  less  data  storage  in  most  cases. 


Resume 


Dans  le  domaine  du  pistage  de  cibles,  des  situations  peuvent  se  produire  ou  les  mesures 
sur  line  cible  particuliere  arrivent  hors  sequence  au  centre  de  traitement.  Ce  probleme 
est  designe  sous  le  nom  de  Mesures  Hors  Sequence  (MHS),  tire  de  l’anglais  “Out-Of- 
Sequence  Measurements”  (OOSMs).  Jusqu’ici,  la  plupart  des  solutions  a  ce  probleme  sont 
basees  sur  le  concept  de  retrodiction.  Cette  methode  utilise  la  projection  dans  le  passe 
(ou  retroprojection)  de  l’etat  courant  estirne  afin  d’incorporer  les  MHS.  Une  nouvelle 
methode  pour  resoudre  le  probleme  des  MHS  est  suggeree,  laquelle  n’utilise  pas  de  la 
de  retroprojection.  Elle  se  base,  plutot,  sur  la  prediction  directe  (vers  l’avant)  et  la  de- 
correlation  de  l’information,  et  se  compare  favorablement  aux  meilleures  methodes  utilisant 
la  retrodiction,  tout  en  exigeant  la  meme  capacite  de  memoire,  et  dans  la  plupart  des  cas, 
une  quantite  moindre. 
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Executive  summary 

Out-of-sequence  measurements  filtering  using  forward  prediction 

F.  Rheaume  ,  A.  Benaskeur ;  DRDC  Valcartier  TR  2005-485;  Defence  R&D  Canada  - 

Valcartier;  August  2007. 

The  tracking  of  dynamic  targets  involves  a  measurement  process  that  collects  and  processes 
data  provided  by  one  or  more  sources.  Because  of  the  temporal  aspect  of  the  tracking 
operation,  the  chronological  appearance  of  the  measurements  is  of  prime  importance.  It 
is  looked  at  and  usually  considered  by  using  a  time  stamp  related  to  each  measurement. 
This  time  stamp  indicates  the  time  at  which  the  measurement  was  collected.  In  many 
applications,  where  most  are  concerned  with  multiple-sensor  tracking,  there  is  a  time  delay 
between  the  instant  at  which  the  measurement  is  collected  from  the  environment  and  the 
instant  at  which  it  is  received  and  processed  by  the  tracking  system.  It  may  happen  that 
the  delay  is  large  enough  so  that  a  measurement  at  a  given  time  arrives  at  the  tracking 
system  after  the  target  track  has  already  been  updated  with  one,  or  more,  more  recently 
collected  measurements.  Such  a  delayed  measurement  is  referred  to  as  an  Out-Of-Sequence 
Measurement  (OOSM). 

So  far,  most  of  the  existing  solutions  to  this  problem  are  based  on  retrodiction.  The 
latter  uses  backward  prediction  of  the  current  estimated  state  in  order  to  incorporate  the 
OOSMs  at  appropriate  time  instants.  A  new  method  to  tackle  the  OOSMs  problem  is 
suggested,  without  the  need  of  backward  prediction.  It  is  based  on  forward  prediction 
and  decorrelation,  and  it  has  proved  to  compare  favorably  to  the  best  retrodiction-based 
algorithms,  while  requiring,  in  most  cases,  less  data  storage.  A  pseudo-track  (or  a  tracklet)  is 
created  using  the  OOSM  and  track  value  at  a  time  prior  to  the  OOSM  date.  Before  being 
fused  with  the  actual  track,  the  created  tracklet  is  predicted  forward  and  de-correlated 
from  the  actual  track  using  a  track  decorrelation  method  similar  to  the  information  filter 
approach.  This  new  proposed  method  does  not  require  the  state  transition  matrix  to  be 
invertible  and  provides  optimal  performance  whether  the  measurements  are  regularly  or 
asynchronously  spaced  in  time,  and  no  matter  if  delays  are  anticipated  or  not. 

Finally,  in  order  to  decide  whether  an  OOSM  should  be  processed  or  discarded,  the  impact 
of  missing  measurements  on  the  track  accuracy  should  be  evaluated.  In  short,  the  impact 
depends  on  the  process  noise,  the  measurement  noise,  the  state  error  covariance  prior  to 
the  OOSM,  the  sampling  interval  and  the  age  of  the  missing  measurement  (the  number  of 
measurement  processed  since  the  OOSM  time).  It  is  shown  that  there  is  a  complex  relation 
between  age  of  the  missing  measurement,  process  noise,  measurement  noise  and  impact  of 
a  missing  measurement  on  track  accuracy. 
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Le  pistage  de  cibles  dynamiques  comporte  une  etape  de  traitement  des  mesures  qui  ras- 
semble  et  traite  les  donnees  fournies  par  une  ou  plusieurs  sources.  En  raison  de  l’aspect 
temporel  de  l’operation  de  pistage,  l’ordre  chronologique  des  mesures  prend  toute  son  im¬ 
portance.  Dans  plusieurs  applications,  ou  la  plupart  sont  a  sources  multiples,  il  peut  y  avoir 
des  delais  entre  l’instant  ou  la  rnesure  est  effectuee  dans  l’environnement  et  l’instant  ou  elle 
est  regue  et  traitee  par  le  systeme  de  pistage.  II  se  peut  que  le  retard  soit  assez  grand  pour 
qu’une  rnesure  effectuee  a  un  temps  donne  arrive  au  systeme  de  pistage  apres  que  la  piste 
d’une  cible  ait  deja  ete  rnise  a  jour  avec  une  ou  plusieurs  mesures  plus  recentes.  Une  rnesure 
ainsi  retardee  est  designee  sous  le  nom  de  Mesure  Hors  Sequence  (MSH),  tire  de  l’anglais 
“Out-Of-Sequence  Measurements”  (OOSM). 

Jusqu’ici,  la  plupart  des  solutions  a  ce  probleme  sont  basees  sur  le  concept  de  retrodiction. 
Cette  methode  utilise  la  projection  vers  l’arriere  de  l’etat  courant  estime  afin  d’incorporer 
les  MHS.  Une  nouvelle  methode  pour  resoudre  le  probleme  des  MHS  est  suggeree,  laquelle 
n’utilise  pas  de  projection  vers  l’arriere  dans  le  temps.  Elle  se  base  plutot  sur  la  prevision 
vers  l’avant  et  la  de-correlation  de  l’information,  et  se  compare  favorablement  aux  meilleures 
methodes  utilisant  la  retrodiction,  tout  en  exigeant  la  meme  capacite  de  memoire,  et  dans 
la  plupart  des  cas,  une  capacite  moindre.  Une  pseudo-piste  (ou  “tracklet”)  est  creee  a  partir 
de  la  MHS  et  de  l’estimation  dans  la  piste  a  un  temps  precedant  celui  de  la  MHS.  Avant 
d’etre  fusionne  avec  la  plus  recente  estimation  dans  la  piste,  la  pseudo-piste  creee  est  predite 
dans  le  temps  et  decorrelee  de  la  plus  recente  estimation  dans  la  piste  par  une  methode 
de  decorrelation  similaire  a  celle  par  le  filtre  d’information  (“information  filter”).  Aussi, 
la  methode  proposee  n’exige  pas  que  la  matrice  de  transition  d’etat  soit  inversible  et  elle 
fournit  des  resultats  optimaux  que  les  mesures  soit  synchrones  ou  asynchrones,  et  peut 
fonctionner  que  les  mesures  hors  sequences  soient  prevues  ou  non. 

En  conclusion,  afin  de  determiner  si  une  MHS  devrait  etre  traitee  ou  simplement  laissee  de 
cote,  l’impact  des  mesures  sur  la  qualite  d’une  piste  devrait  etre  evalue.  En  bref,  l’impact 
d’une  mesure  depend  du  bruit  de  processus,  du  bruit  dans  les  mesures,  de  la  covariance  de 
l’erreur  sur  l’etat  estime  avant  le  temps  du  MHS,  de  l’intervalle  de  prelevement  de  mesures 
et  de  Page  de  la  mesure  hors  sequence,  qui  est  represente  par  le  nombre  de  mesures  traitees 
depuis  le  temps  de  la  MHS. 
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1  Introduction 


The  tracking  of  dynamic  targets  involves  a  measurement  process  that  collects  and  pro¬ 
cesses  data  provided  by  one  or  more  sources.  This  tracking  process  aims  at  producing  a 
mathematical  model  of  the  time  history  for  the  target  kinematics  [22],  It  uses  the  past 
measurements  to  estimate  the  temporal  equations  of  the  observed  state  (track  update)  and 
also  to  predict,  in  time,  the  state  expected  to  be  observed  (track  prediction).  Because  of  the 
temporal  aspect  of  tracking  operation,  the  chronological  appearance  of  the  measurements 
is  of  prime  importance  to  the  estimation  process.  The  measurements  are  usually  considered 
by  using  a  time  stamp  related  to  each  measurement.  This  time  stamp  indicates  the  time 
at  which  the  measurement  was  collected. 

In  many  applications,  where  most  are  concerned  with  multiple-sensor  tracking,  there  is  a 
time  delay  between  the  instant  at  which  the  measurement  is  collected  from  the  environment 
and  the  instant  at  which  it  is  received  and  processed  by  the  tracking  system.  Such  a  delay, 
that  may  arise  from  many  factors,  such  as  the  sensor  diversity,  communication  delays  and 
unsteady  pre-processing  times  of  the  observed  data,  depending  on  the  system  load,  can 
vary  from  one  measurement  to  another.  It  may  happen  that  the  delay  is  large  enough  so 
that  a  measurement  taken  at  a  time  tT  arrives  at  the  tracking  system  at  a  time  td  >  t^, 
that  is  after  the  target  track  has  already  been  updated  with  one,  or  more,  more  recently 
collected  measurements.  Such  a  delayed  measurement  is  referred  to  as  an  Out-Of-Sequence 
Measurement  (OOSM)  [2].  The  problem  of  the  OOSM  comes  to  update  the  track  corre¬ 
sponding  to  the  given  target,  at  the  current  time  td,  using  the  older  measurement  from 
time  tT,  given  that  the  track  has  already  been  updated  by  measurements  collected  after 
time  tT.  This  problem  is  also  referred  to  as  the  problem  of  tracking  with  random  sampling 
and  delays  [15]  or  negative-time  measurement  update  [2], 

A  direct  solution  to  the  OOSM  problem  is  simply  to  ignore  and  discard  the  OOSM  in  the 
tracking  process.  This  solution  leads  obviously  to  a  loss  of  the  information  contained  in  the 
discarded  OOSM.  To  avoid  such  a  drawback,  a  simple  alternative  consists  in  reprocessing, 
in  chronological  order,  all  measurements  that  are  collected  from  the  OOSM  time  tT  to  the 
time  td  [7].  This  solution  yields  optimal  track  quality.  Nevertheless,  it  is  inefficient  because 
of  its  high  computation  and  storage  requirements.  In  most  cases,  it  is  even  unfeasible  since 
most  tracking  systems  keep  only  the  current  state  estimate  and  the  corresponding  error 
covariance  matrix. 

Several  methods  have  been  proposed  in  the  literature  to  deal  more  efficiently  with  the 
OOSM  problem.  Most  of  these  methods  are  based  on  backward  prediction  of  the  current 
state  to  incorporate  the  OOSMs,  also  referred  to  as  retrodiction  approach  [3,  6,  2,  7,  21,  15, 
11,  9,  16,  19,  25,  18,  17].  All  the  retrodiction-based  methods  vary  in  how  the  process  noise 
is  accounted  for  during  the  retrodiction.  The  suggested  methods  in  [7,  21,  15]  compensate 
partially  for  the  process  noise,  or  simply  ignore  it.  The  major  difficulty  here  is  that  there  is  a 
strong  dependency  between  the  retrodicted  process  noise  and  the  current  state  in  backward 
prediction. 

In  this  report,  a  new  method  that  does  not  rely  on  retrodiction  is  proposed.  The  main  idea 
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consists  in  combining  forward  prediction  with  track  decorrelation,  as  used  in  the  information 
filter  approach  [12],  to  optimally  incorporate  the  OOSMs.  This  is  why  the  method  is 
referred  to  as  Forward-Prediction  Fusion  and  Decorrelation  (FPFD).  The  proposed  method 
has  proved  to  provide  performance  that  compares  favorably  to  the  best  retrodiction-based 
algorithms,  while  requiring,  in  most  cases,  less  data  storage. 

This  report  is  organized  as  follows.  The  problem  of  OOSMs  is  stated  in  Chapter  2.  In 
Chapter  3  are  discussed  the  retrodiction-based  methods.  Before  addressing  the  OOSM 
solution,  a  study  of  the  impact  of  missing  measurements  on  tracks  is  presented  in  Chapter  4. 
Then  the  proposed  FPFD  approach  is  described  in  Chapter  5.  In  Chapter  6,  comparison 
results  and  performance  discussion  of  the  FPFD  method  are  provided.  Finally,  concluding 
remarks  about  the  proposed  method  are  given  in  Chapter  7. 
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2  Problem  statement 


The  dynamical  model  of  the  target  of  interest  is  assumed  to  be 

x(k)  =  F(k,  k  —  1  )x(k  —  1)  +  v(k,  k  —  1)  (1) 

with  F(k,k  —  1)  the  state  transition  matrix  from  time  t^-i  to  time  tk  and  v(k,k  —  1) 
represents  the  effect  of  the  process  noise  from  time  tk- 1  to  time  tk-  The  measurement 
model  is 

z(k)  =  H(k)x(k)+w(k)  (2) 

where  H(k )  is  the  measurement  matrix  and  uj(k)  is  the  measurement  noise.  The  process 
noise  v(k,  k  —  1)  and  the  measurement  noise  co(k)  are  assumed  to  be  white  with  zero  mean 
and  covariance  matrices  Q(k,k  —  1)  and  R(k),  respectively.  Details  on  F(k,k  —  1)  and 
Q(k,k  —  1)  are  given  in  Section  A.  Also,  note  that  throughout  this  work  the  continuous 
time  representation  of  a  discrete  time  i  is  noted  t*. 
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Figure  1:  Out-of-sequence  measurement 


The  role  of  the  tracking  system  is  to  update  the  target  track  composed  of  a  state  estimate 
x  and  an  estimation  error  covariance  matrix  P.  It  is  assumed  that  a  measurement  2 
is  collected  and  used  to  update  the  track  at  the  time  interval  h.  At  time  tk,  the  tracking 
system  computes  the  state  estimate  x(k\k)  and  its  corresponding  estimated  error  covariance 
matrix  P(k \k) 


x(k\k)  =  E 


x[k) 


(3) 


P(k\k) 


cov 


x(k) 


(4) 
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where  Zk  corresponds  to  the  measurement  sequence  up  to  time  instant  t^,  excluding  a 
measurement  z(r)  with  a  time  stamp  tT  <  th,  as  shown  in  Figure  1.  Once  z(t)  arrives  at 
the  processing  center,  with  a  certain  delay,  the  problem  comes  to  calculate  x(A;|A;,t)  and 
P(k\k,r)  that  take  into  consideration  the  OOSM  z(r),  as  shown  below. 


x(k\k,  t)  =  E  x(k ) 
P(k\k,  t)  =  cov  x(k) 


Z\z(t) 


Zk,z(r) 


(5) 

(6) 


Furthermore,  depending  on  the  delay  time  r,  an  OOSM  can  have  different  step  lag  values. 
Then,  a  l- step  lag  OOSM  is  defined  as  an  OOSM  for  which 

l  =  k  —  t  (7) 
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3  Backward  prediction  methods 


A  widely  used  approach  to  tackle  the  problem  of  OOSMs  in  tracking  is  based  on  the 
“prediction”  of  the  state  estimate  back  to  the  time  of  the  delayed  measurement.  Depending 
on  the  authors,  this  approach  may  be  referred  to  as  retrodiction,  backward  prediction 
or  reverse-time  prediction.  It  sums  up  to  predict  the  track  from  the  last  update  time  k 
backward  to  the  time  r  of  the  OOSM,  and  then  update  the  track  using  the  OOSM  and 
then  predict  forward  from  time  instant  r  to  time  instant  k. 

Various  retrodiction  methods  have  been  presented  in  the  literature  recently  [3,  6,  2,  7,  21, 
15,  11,  9,  16,  19,  25,  18,  17].  In  [2],  a  retrodiction  method  is  suggested,  which  is  presented  as 
an  exact  solution  compared  to  those  in  [7,  21,  15],  insofar  as  the  process  noise  is  accounted 
for  entirely  during  the  retrodiction.  This  solution  has  proved  to  give  optimal  results  for 
the  case  where  the  OOSM  lies  between  the  last  two  measurements,  which  is  also  called  the 
1-step  lag  case.  The  problem  with  this  algorithm,  compared  to  those  presented  in  [21,  15], 
where  the  process  noise  in  the  retrodiction  process  is  only  partially  compensated  for,  is 
that  it  requires  storage  of  the  innovation.  The  optimal  approach  described  in  [2]  and  the 
suboptimal  approaches  in  [21,  15]  were  extended  in  [3]  to  the  case  of  an  OOSM  with  an 
arbitrary  lag,  that  is  an  OOSM  whose  time  stamp  can  be  earlier  than  the  last  sampling 
interval.  The  approach  in  [3]  for  an  arbitrary  lag,  which  was  originally  presented  in  [6], 
uses  an  equivalent  measurement  concept.  This  concept  was  first  presented  in  [13,  14].  The 
equivalent  measurement  combines  together  all  the  measurements  that  are  more  recent  than 
the  OOSM.  This  concept  was  used  to  extend  the  algorithms  in  [2],  the  optimal  and  the 
suboptimal,  to  the  case  of  an  n-step  lag  OOSM.  The  authors  concluded  in  [3]  that  the 
suboptimal  algorithm,  which  ignores  the  retrodicted  noise,  is  a  good  compromise  between 
accuracy  and  cost. 

All  of  the  above-discussed  retrodiction-based  methods  have  some  advantages  and  some 
drawbacks.  The  optimal  solutions  presented  in  [19,  25]  require  a  large  storage  capacity 
compared  to  other  suboptimal  OOSM  methods.  The  equivalent  measurement  concept  with 
backward  prediction  presented  in  [3]  also  necessitates  a  considerable  amount  of  data  stor¬ 
age.  Even  in  the  case  where  the  retrodicted  noise  is  ignored,  covariance  of  the  equivalent 
innovation  needs  to  be  computed.  This  requires  storage  of  the  error  covariance  matrices 
corresponding  to  the  state  estimates  based  on  all  measurement  time  stamps  that  are  sub¬ 
sequent  to  the  OOSM.  The  same  applies  to  the  Augmented  State  Kalman  Filter  method 
presented  in  [9],  which  also  uses  equivalent  measurements. 
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4  Impact  of  missing  measurements  on  track  quality 


In  the  presence  of  OOSMs,  an  interesting  issue  concerns  the  evaluation  of  the  accuracy 
that  is  gained  or  lost  whether  a  track  has  a  measurement  update  or  not.  In  other  words, 
it  should  be  determined  how  useful  is  the  inclusion  of  an  OOSM  to  the  current  estimate, 
in  order  to  decide  whether  the  OOSM  should  be  included  or  discarded.  To  answer  that 
question,  the  impact  of  a  particular  measurement  on  track  accuracy  must  be  determined. 
In  [20],  it  is  suggested  that  the  decision  to  include  or  not  an  OOSM  should  be  based  on  a 
utility  measure  of  the  measurement.  Here  are  studied  the  factors  that  influence  the  impact 
of  missing  measurements  on  track  accuracy.  The  study  separates  in  two  cases:  the  0-step 
miss  case  and  the  multi-step  miss  case.  Figure  2  shows  both  cases,  where  the  1-step  and 
2-step  miss  cases  corresponds  to  the  multi-step  case.  It  will  be  shown  that  the  impact 
of  missing  measurements  on  track  quality  is  influenced  differently  depending  wheth-er  the 
miss  is  0-step  or  multi-step. 


No  miss 

-J 

i  p(k) 

X  X 

x 

^  :  Measurement 

0-step  miss 

X _ y 

-4T 

-O  Pt/J0(k) 

— :  Prediction 

1-step  miss 

*  i 

— o — 

Pln(k) 

Q  ;  Missing 

measurement 

2-step  miss 

-J- 

P,J2(k) 

k  -  3  k  -  2 

k  - 1 

k 

Figure  2:  Track  comparison  between  no  miss,  miss  at  current  time  (0-step  lag),  1-step  lag, 
2-step  lag  and  3-step  lag.  All  tracks  originate  from  the  same  one  prior  to  time  k  —  3. 

4.1  Factors 

There  are  some  different  factors  that  determine  the  degree  of  the  impact  of  missing  mea¬ 
surements  on  the  track  accuracy.  With  dynamic  processes,  the  most  obvious  one  is  the  age 
of  the  missing  measurement,  in  that  older  missing  measurements  should  have  less  impact 
on  the  track  accuracy  than  the  newer  ones.  The  influence  of  age  can  be  explained  by  the 
Kalman  filter  recursiveness.  Therefore,  the  age  of  a  measurement  is  determined  by  the 
number  of  subsequent  measurements.  The  degree  of  impact  should  also  be  related  in  some 
way  to  the  process  noise,  the  measurement  noise,  the  state  estimated  error  covariance  prior 
to  the  time  of  the  missing  measurement,  and  the  sampling  interval. 

Suppose  that  at  time  k  —  1  a  track  has  a  related  estimated  error  covariance  matrix  P(k  —  1). 
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Here  P  will  be  referred  to  as  the  estimated  covariance  matrix  of  the  track  that  would  have 
had  all  the  measurements,  while  P ^  will  be  defined  as  the  estimated  covariance  matrix  of 
the  track  that  misses  the  measurement.  Furthermore,  in  order  to  simplify  calculations,  let 
define  the  measurement  error  covariance  matrix  in  terms  of  a  unique  measurement  error 
covariance  al  for  all  of  the  space  dimensions 

R  =  a2RI  (8) 

Also, 

t  =  rrT  (9) 

where  T  is  the  process  noise  gain  matrix  such  that 

Q  =  (io) 

and  where  a2  is  the  process  noise  variance.  Finally,  let  us  have 

c  =  [hth}~1  (11) 

where  H  is  the  measurement  matrix. 

0-step  miss 

The  0-step  miss  case  is  the  one  where  a  measurement  is  missing  at  the  current  update  time 
k.  In  that  case,  the  last  measurement  inclusion  happened  before  the  missing  measurement 
time. 

Suppose  that  at  time  k,  a  measurement  update  is  scheduled,  given  that  a  measurement  is 
available.  In  the  case  where  the  measurement  is  available  (No  miss  case  in  Figure  2),  the 
track  accuracy  expressed  in  the  information  space  is 

1  -1  r  -i-l 

P{k)~l  =  FP(k  -  1)Ft  +  alT  +  a2RC  (12) 

In  the  case  where  the  measurement  at  time  k  is  missing  (0-step  lag  case  in  Figure  2),  there 
is  no  measurement  update  at  time  k  and  the  track  accuracy  is  only  defined  by  the  filter 
prediction 

P(k)^=  FP(k-l)FT  +  a2vT  (13) 

According  to  (12)  and  (13),  the  ratio  of  the  track  estimated  error  covariance  without  a 
measurement  update  at  time  k  ( P{k )^)  to  the  track  estimated  error  covariance  with  a 
measurement  update  at  time  k  ( P{k ))  is: 

PrpP1  =  FP(k-l)FT +  a2vT  ([FP(k-l)FT  Fair]-1  +  [a|C]_1)  (14) 

=  1  +  FP(k  -  1  )FTa~R2C1  +  o-la^C1  (15) 

According  to  (15),  the  impact  of  a  0-step  missing  measurement  on  the  track  accuracy  is 
influenced  by 
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1.  a2aR2,  which  represents  the  ratio  of  the  process  noise  variance  to  the  measurement 
noise  variance. 

2.  FP{k  —  1  )F2  crR2,  which  involves  the  transition  matrix  and  the  estimated  error  co- 
variance  at  time  k  —  1  and  the  measurement  noise  variance. 


To  have  a  more  explicit  analysis  of  the  factors  that  influence  the  impact  of  a  0-step  missing 
measurements  on  track  accuracy,  assume  the  following  1-dimension  constant  velocity  model 
with  white  noise  acceleration 


x(k  +  1)  =  Fx(k)  +  Tv(k) 


where 


F  = 


and 


'1  h 
0  0 

h2/2 
h 

and  where  h  is  the  sampling  interval  time.  The  process  noise  covariance  matrix  is 


Q  =  < 


h4/4  h3/ 2 
h3/ 2  h2 


Also,  let  P(k  —  1)  be  defined  as 


P(k-  1)  = 


°lx 

2  2 
\J~^  xx  ® xx . 


(16) 

(17) 

(18) 

(19) 

(20) 


According  to  that,  in  the  case  where  a  measurement  update  occurs  at  time  k,  the  position 
error  variance  cr2(k)  at  time  k  is 


cr2x(k)  = 


1 


n  -i 


-2 


(ax  +  2 crxih  +  crxx  +  -cq,h  )  +  aR 


(21) 


where  aR  is  the  measurement  variance.  In  the  case  where  a  measurement  update  does  not 
occur  at  time  k,  the  position  error  variance  a2  (. k )  at  time  k  is 


^  ( k )  =  ai  +  2(j2x±h  +  alx  +  ja2h4 


(22) 


Using  (21)  and  (22),  the  ratio  of  the  position  estimated  error  variance  with  a  measurement 
update  at  time  k  to  the  position  estimated  error  variance  without  a  measurement  update 
at  time  k  is 

=  1  +  ax  +  2°l±h  +  °±xh2  +  \alhA  (23) 


a. 

a 


2 

Y 


a 


R 


Equation  (23)  shows  the  influence  of  a2,  aR  and  h  as  well  as  the  state  error  covariances 
CxYIx  and  aix-  Note  that 


O) 


(J2x{k) 


>  1 


(24) 


for  the  0-step  lag  case  shown  in  Figure  2. 

Therefore,  according  to  the  above  analysis,  it  follows  that 
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1.  The  higher  av/aR  is,  and 

2.  the  higher  the  initial  estimated  error  covariance  is, 

the  more  a  0-step  missing  measurement  will  have  an  impact  on  the  track  accuracy. 

Multi-step  miss 

The  multi-step  miss  case  is  the  one  where  a  measurement  has  been  missing  and  where  new 
measurements  have  been  included  since  then.  In  that  case,  the  last  measurement  inclusion 
happened  after  the  missing  measurement  time.  Unlike  the  0-step  miss  case  and  because  the 
last  measurement  inclusion  happened  after  the  missing  measurement  time,  it  is  believed  that 
the  (Jv/(Jfi  ratio  will  not  have  the  same  impact  on  track  accuracy.  Because  of  the  recursive 
nature  of  the  Kalman  filter,  this  multi-step  miss  case  will  not  be  developed  analytically  (see 
Section  B  for  some  brief  analysis).  Rather,  it  will  be  studied  quantitatively  in  Section  4.2. 
It  will  also  be  shown  that  the  later  the  missing  measurement  occurs  in  the  track  update 
sequence,  the  more  its  impact  over  track  accuracy. 

4.2  Quantitative  analysis 

Tests  were  made  to  quantify  how  av ,  or  and  age  of  the  missing  measurement  influence  the 
track  estimated  error  covariances.  The  0-step  miss  case  and  the  multi-step  miss  case  are 
presented. 

The  impact  of  a  missing  measurement  on  track  accuracy  is  measured  in  terms  of  the  deter¬ 
minant  ratio  (DR),  defined  as  follows 

det(P^,(fc)) 
det(P(k)) 

The  determinant  ratio  is  a  way  to  compare  the  estimated  error  covariance  matrix  of  the 
track  that  misses  a  measurement  (p*i  ( k ))  with  the  estimated  error  covariance  matrix  of 
the  track  that  does  not  miss  the  measurement  ( P(k ))  [23].  Note  that  Pipi  ( k )  refers  to  the 
state  estimated  covariance  matrix  at  time  k  for  which  a  measurement  is  missing  at  time 
k  —  l,  as  shown  in  Figure  2.  I  expresses  the  age  of  the  missing  measurement,  or  its  lag, 
defined  as  the  number  of  update  intervals  passed  since  the  missing  measurement  time  and 
up  to  the  current  time.  DR  is  always  greater  than  1,  and  as  DR  approaches  1,  the  missing 
measurements  have  less  impact  on  the  track  accuracy. 

0-step  miss 

With  the  0-step  miss  case,  the  impact  of  a  missing  measurement  over  track  accuracy  is 
expected  to  increase  as  the  ratio  ov/or  increases.  Tests  made  with  different  crv/(JR  values 
verify  this  statement,  as  shows  Table  1.  In  fact,  for  a  noise  ratio  ov/or,  of  0.02,  the  DR  is 
about  2.  This  represents  a  relatively  small  impact  compared  with  the  case  of  ovj  or  =  50 
and  where  the  DR  is  about  513950.  Thus  track  uncertainty  of  tracks  that  misses  the  last 
measurement  is  much  more  high  for  high  ov/or  ratios  than  for  low  ones. 


(25) 
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Pv/VR 

DR 

.02 

2.0 

.1 

2.5 

1 

16.0 

10 

2206.9 

50 

513950.6 

Table  1:  DR  for  the  0-step  miss  case  and  for  different  noise  ratio  values  (■ gv/gr ) 


Multi-step  miss 

With  the  multi-step  miss  case,  the  impact  of  a  missing  measurement  over  track  accuracy 
varies  depending  on  ctv/(Tr,  although  it  is  hard  to  find  the  relation  between  av/c tr  and  the 
impact.  A  more  extensive  study  would  be  needed. 

Anyhow,  Table  2  shows  that  there  are  gv/gr  values  for  which  the  impact  is  not  negligible 
even  for  higher  step  misses.  With  low  <jv/gr  ratios  we  have  DR  >  1  even  for  4-step,  5- 
step  and  6-stcp  missing  measurement.  For  example,  with  av/aR  =  0.005  and  with  a  5-step 
missing  measurement  the  determinant  ratio  is  1.19.  Low  gv/or  ratios  have  less  impact  than 
high  gv/gr  ratios  for  the  small  step  miss  cases  (such  as  3-step,  2-step  and  1-step  missing 
measurements).  As  the  number  of  steps  increases,  it  seems  that  the  more  gv/gr  gets  close 
to  1,  the  less  is  the  impact  of  the  missing  measurement  over  track  accuracy.  Figure  3 
illustrates  the  variation  of  DR  for  different  <jv/<tr  values  and  for  different  step  misses. 


l 

6 

5 

4 

3 

2 

1 

0 

.005 

1.225 

1.191 

1.193 

1.231 

1.312 

1.448 

1.665 

.02 

1.164 

1.154 

1.173 

1.221 

1.307 

1.447 

1.669 

.1 

1.046 

1.074 

1.117 

1.179 

1.274 

1.433 

1.743 

&v/&R 

1 

1.000 

1.001 

1.003 

1.009 

1.058 

1.320 

2.142 

10 

1.000 

1.000 

1.002 

1.011 

1.077 

1.600 

10.023 

50 

1.981 

2.413 

3.178 

4.699 

8.359 

21.084 

146.121 

Table  2:  DR  for  different  miss  lags  and  different  noise  ratio  values  (a v/ctr) 


From  the  above  discussion,  and  from  the  results  of  Tables  1  and  2,  the  following  conclusions 
can  be  drawn  with  respect  to  the  impact  of  the  missing  measurements  on  track  accuracy. 

First,  in  terms  of  track  accuracy  it  is  always  better  to  include  a  measurement  than  discarding 
it  if  the  measurement  accuracy  does  not  change  through  time.  Still,  the  impact  on  track 
accuracy  can  variate  depending  on  several  parameters,  that  include  the  gv/gr  ratio,  the 
initial  estimated  error  covariance,  the  sampling  interval  h ,  and  the  missing  measurement 
lag  l.  From  the  results  shown  in  Tables  1  and  2,  there  is  an  evidence  that  there  may  be 
situations  where  older  measurements  have  a  non-negligible  impact  on  track  accuracy.  The 
impact  is  not  the  same  depending  on  the  age  of  the  missing  measurement. 
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Figure  3:  DR  for  different  miss  lags  and  different  noise  ratio  values  ( crv/&R ) 


Based  on  these  remarks  and  following  a  more  extensive  study,  the  crv/aji  ratio  could  be 
used  to  decide  whether  an  OOSM  should  be  discarded  or  not,  depending  on  its  predicted 
impact  on  track  accuracy.  Moreover,  the  decision  to  reject  or  not  an  OOSM  may  ultimately 
be  based  on  computation  and  memory  requirements.  Chapter  5  presents  an  new  algorithm 
that  reduces  the  memory  requirements  for  the  inclusion  of  OOSMs. 
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5  Forward-Prediction  Fusion  and  Decorrelation 


The  Forward-Prediction  Fusion  and  Decorrelation  (FPFD)  method,  proposed  in  this  docu¬ 
ment,  uses  a  decorrelation  technique  originally  presented  in  [12]  and  exploited  in  the  infor¬ 
mation  filter  used  for  track-to-track  fusion.  A  forward  predicted  version  of  a  tracklet  that 
uses  the  OOSM  is  fused  with  the  current  track  using  the  information  form  of  the  Kalman 
Filter.  A  tracklet  is  used,  instead  of  a  complete  track,  to  remove  the  correlation  between 
the  two  pieces  of  information  and  created  by  their  common  history.  Such  a  decorrelation 
aims  at  making  the  OOSM-based  tracklet  independent  of  the  current  track. 

5.1  Algorithm 

At  time  k ,  before  the  OOSM  is  processed,  the  state  estimate  and  its  error  covariance  matrix 
are  represented  by  x(k\k)  and  P(k\k)  respectively.  As  shown  in  Figure  4,  the  OOSM  is 
predicted  forwards  up  to  time  k  in  order  to  incorporate  the  OOSM  z(t)  into  the  current 
state  estimate  x(k\k).  This  requires  knowledge  of  the  state  estimate  at  a  time  4  <  tT. 

The  forward  predicted  OOSM  x(k\r)*  and  the  corresponding  covariance  matrix  P{k\r)*  are 
used  to  update  the  track  x(k\k),  P{k\k )  at  time  k.  The  goal  is  to  have  a  forward  predicted 
OOSM  x(k\r)*  and  its  covariance  matrix  P(k\r)*  such  that  the  state  estimate  obtained 
by  using  the  forward  predicted  OOSM  will  be  the  same  as  when  all  the  measurements 
(including  the  OOSM)  are  processed  sequentially.  This  requires  independence  of  x(k\r)* 
and  x{k\k).  Consequently,  the  covariance  update  for  the  forward  predicted  OOSM  is  given 
by 


P~l{k\k)*  =  p-\k\k )  +  p-\k\T)*  (26) 

=  p-\k\k,r)  (27) 

where  P~1(k\k,r)  represents  the  inverse  of  the  covariance  matrix  after  the  OOSM  has 
been  included  and  P~1(k\k)*  represents  the  inverse  of  the  covariance  matrix  of  the  state 
estimate  x{k\k)* .  x(k\k)*  results  from  the  in-sequence  reprocessing  of  all  the  measurements 
(including  the  OOSM). 

Equation  (26)  represents  the  optimal  solution  where  x(k\r)*  and  x{k\k)  are  independent. 
The  followings  will  show  our  approach  to  get  x(k\r)*. 

Let  us  consider  a  forward  predicted  OOSM  x(k\r)^  and  its  covariance  matrix  P(fc|r)'1'. 
These  are  given  based  on  the  state  estimate  x(b),  with  tb  <  tT,  and  the  corresponding  error 
covariance  matrix  P(b ) 

P(r\b)  =  F(t,  b)P(b)F(r,  b)T  +  Q(r,  b)  (28) 

P“Vk)*  =  P_1(r|6)  +  H(t)t  p-1(r)P‘(r)  (29) 

P(k\T)'i>  =  F(k ,  t)P(t\t)'1’ F(k,  t)t  +  Q(k,  r)  (30) 
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and 


x(r\b)  =  F(r,b)x(b)  (31) 

P_1  =  P_1(t|6):k(t|&)  +  H  (t)t  R1  (t)  z(t)  (32) 

x(k\r)^  =  F(k,  t)x(t\t)^  (33) 

where  F(j,i)  represents  the  state  transition  matrix  from  time  ti  to  time  tj  and  Q(j,i )  is 
the  process  noise  error  covariance  matrix  for  the  time  interval  [tt,  tj] . 

x(k\r and  x(k\k)  are  correlated  since  they  share  the  same  history  (i.e.,  x(b))  and  both 
rely  on  the  same  prediction  model  between  tb  to  tk-  To  have  fusion  of  independent  pieces  of 
information,  the  redundant  information  between  the  forward  predicted  OOSM  x(k\r)^  and 
the  state  estimate  x(k\k)  must  be  removed.  Let  this  redundant  information  be  represented 
by  the  forward  prediction  of  the  state  estimate  x(b)  from  time  tb  to  tk,  denoted  x(k\b).  The 
prediction  of  the  state  estimate  from  time  tb  to  t*.  and  the  corresponding  error  covariance 
matrix  are  given  by 


x(k\b)  =F(k,b)x(b)  (34) 

P(k\b)  =  F{k ,  b)P(b)F(k ,  b)T  +  Q(k,  b )  (35) 

Using  the  information  form  [12],  the  de-correlation  of  the  forward  predicted  OOSM  x{r\b) 
from  the  state  estimate  x(k\b)  is  given  by 

P_1(lfe|r)*  =  P~\k\Tf  -  p-\k\b )  (36) 

P1  (k\r)*  x(k\r)*  =  P_1(A:|r)'I'*(/c|r)'1'  —  P~1(k\b)x(k\b)  (37) 

where  x(k\r)*  is  the  resulting  de-correlated  measurement  and  P(fc|r)*  is  its  corresponding 
covariance  matrix. 

Finally,  the  current  state  estimate  x(k\k)  is  updated  with  the  forward  predicted  OOSM 
x(k\r)*.  Using  the  information  fusion  form  as  in  (26),  the  covariance  update  for  the  forward 
predicted  OOSM  is 


P-1(fc|fc,  r)  =  P~l{k\k)  +  P~l{k\T)*  (38) 

and  the  state  update  is 

P_1(lfe|A;,  r)x(k\k,  r)  =  P~1(k\k)x(k\k)  +  P1  (k\r)* x(k\r)* .  (39) 

5.2  Impact  of  the  correlation  between  the  process  noise  and  the 
current  state 

An  OOSM  algorithm  is  optimal  if  it  performs  exactly  as  the  in-sequence  measurements 
reprocessing  method.  In  order  to  have  the  FPFD  method  optimal,  the  fusion  of  the  forward 
predicted  OOSM  x(k\r)*  at  time  tk  must  be  equivalent  to  the  fusion  of  the  OOSM  z(r)  at 
time  tT. 
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When  no  measurements  have  contributed  to  the  state  estimate  between  ]tb,tT[  and  ]tT,tk[, 
the  FPFD  method  is  optimal.  This  corresponds  to  the  1-step  lag  OOSM  case.  The  opti¬ 
mality  comes  from  the  fact  there  is  no  correlation  between  the  process  noise  and  the  state 
estimate  over  the  intervals  ]tb,tT[  and  ]tT,tk[- 


E 

e\ 


x(r\b)v(T,  b ) 
x(k\r)v(k,  t) 


t 


T 


=  0,  if  zi~l 


k- 1 


=  0,  if  ZT+1 


{0}, 

{0}, 


(40) 

(41) 


where  Z^A1  and  Z^~*  are  the  cumulative  sets  of  measurements  from  time  4+1  to  time  tT—i 
and  from  time  tT+ 1  to  time  tk—i  respectively.  In  that  case  the  estimation  of  the  state  x 
over  the  intervals  ]4,  tT[  and  ]tT,  tk[  uses  forward  prediction  only,  so  that  it  does  not  depend 
on  the  process  noise.  Then,  the  forward  prediction  of  the  OOSM  z(t)  provides  an  optimal 
fusion  since  the  process  noise  does  not  influence  the  state  estimate  x  between  ]4,tT[  and 
]^T>  tk\- 

However,  when  there  are  one  or  more  measurements  between  ]tb,  tT[  or  between  ]tT,  tk[,  there 
is  some  correlation  between  the  process  noise  and  the  state  estimates  for  the  corresponding 
intervals  ]tb,tT[  or  ]tT,tk[-  This  corresponds  to  the  multiple-step  lag  OOSM  case. 


E 


x(j\j)v(j,j  -  1)T 


+  0,  if  3z(J), 


(42) 


with 


j  =  b+  1,. ..  ,r 


or 

j  =  T  +  1,  .  .  .  ,  k 

and  where  x(j\j)  has  been  updated  with  measurement  z(j).  Equations  (1)  and  (2)  demon¬ 
strate  that  z(j)  depends  on  x(j),  and  that  x(j)  depends  on  v(j,j  —  1).  Therefore  x(J\j) 
and  v(j.  j  —  1)  are  correlated  since  x(j\j)  has  been  updated  with  z(j). 


The  estimation  of  the  state  x  over  the  intervals  ]t&,  tT[  and  ]tT.  t^[  depends  on  the  measure¬ 
ments  Z^Z i  and  Z1!^  (  and  on  the  forward  prediction  model.  Therefore  the  state  estimate  x 
over  the  intervals  ]b,,  tT[  and  ]tT,  tk[  does  depend  on  the  process  noise  cumulated  over  ]tb,tT[ 
and  ]tT,tk[-  This  correlation  between  the  process  noise  and  the  state  estimate  is  not  taken 
into  account  by  x(k\r)*.  Hence,  the  fusion  of  x{k\ r)*  and  x{k\k)  is  not  optimal  when  there 
are  one  or  more  measurements  between  ]tb,tT[  or  between  ]tT,tk[- 

Let  e  be  the  discrepancy  caused  by  ignoring  the  process  noise  in  x(k\r)*  and  E  be  its 
corresponding  covariance  matrix.  As  a  comparison  with  the  optimal  case  shown  in  (26)  and 
according  to  e  and  E.  we  have 

P_1(fc|A;)*  =  P~1(k\k)  +  P~1(k\r)*  +  FT1  (43) 

=  P~\k\k,T )  (44) 
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and 


(45) 

(46) 


P  1(k\k)*x(k\k)*  =P  l{k\k)x(k\k)  +  P  1  {k\r)* x{k\r)* 

+  £T1e 

=P~l(k\k,  r)x(k\k,  r). 

Note  that  the  equivalent  measurement  retrodiction  solution  presented  in  [3]  faces  the  same 
correlation  problem  for  multiple-step  lag  OOSMs. 

5.3  Data  storage 

Data  storage  may  be  a  relevant  issue  depending  on  the  storage  capacity  available  in  a 
tracking  system.  The  storage  requirements  of  the  retrodiction-based  algorithms  A/1  and 
B/l  from  [3],  as  well  as  of  the  optimal  algorithm  presented  in  [25],  will  be  compared  with 
the  storage  requirements  of  algorithm  FPFD. 

As  mentioned  in  [3],  all  OOSM  algorithms  necessitate,  at  least,  the  storage  of  the  following 
data:  i)  a  scalar  for  the  time  stamp  of  the  next  update;  ii)  n  scalars  for  the  state  estimate; 
and  iii)  n(n  +  l)/2  scalars  for  the  covariance  of  the  state  estimate.  Furthermore,  algorithm 
FPFD  requires;  i)  a  scalar  for  the  time  stamp  tb  associated  with  track  x(b),  P(b);  ii)  n 
scalars  for  the  state  estimate  x(b)  held  in  memory  at  time  instant  tb',  iii)  n(n  +  l)/2  scalars 
for  the  covariance  P(b)  of  the  state  estimate. 

Based  on  the  numbers  given  above,  algorithm  FPFD  requires  a  storage  of  n2+3n+2  scalars. 
Because  the  delay  of  an  OOSM  cannot  be  predicted  in  advance,  a  maximum  number  of  lags 
Imax  needs  to  be  determined.  This  maximum  number  of  lags  lmax  has  a  direct  impact  on 
the  storage  requirements  of  the  retrodiction-based  algorithms.  As  shown  below,  the  storage 
requirements  for  the  FPFD  approach  do  not  depend  on  lmax1-  Some  details  about  the 
storage  requirements  for  algorithms  A/1  and  B/l  are  provided  in  [3].  The  total  number  of 
scalars  stored  for  each  OOSM  algorithm  is  given  below 

FPFD  :  n2  +  3n  +  2  (47) 

A/1  :  \lmax  +  1](n2  +  3n  +  2)  (48) 

B/l  :  l'nax^+  1  (n2  +  3n  +  2)  -  nlmax  (49) 

The  data  storage  requirements  of  the  FPFD,  A/1  and  B/l  algorithms  are  less  than  those  of 

the  optimal  algorithm  presented  in  [25],  which  requires  at  least2 

4 lmax  -  1  2  ,  8lmax  ~  1  ,  fern 

2  fl'  \  2  '  Lmax  v'JU/ 

1  Although  the  storage  requirements  of  algorithm  FPFD  do  not  depend  on  a  predetermined  maximum 
number  of  lags  lmax,  its  performance  in  terms  of  track  accuracy  does  depend  on  lmax ■  This  is  discussed  in 
Section  5.4. 

2Data  storage  requirements  for  Case  /  :  Perfect  knowledge  about  r  at  time  j  +  1  in  [25]. 
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scalars. 


Table  3  shows  the  data  storage  requirements  in  terms  of  lmax  for  a  state  vector  of  4  dimen¬ 
sions. 


lmax 

1 

2 

3 

4 

FPFD 

30 

30 

30 

30 

ad 

30 

45 

60 

75 

Bn 

26 

37 

48 

59 

Algorithm  I  in  [25] 

39 

88 

137 

186 

Table  3:  Number  of  scalars  needed  to  be  stored  in  terms  of  lmax  and  for  a  state  vector  of  4 
dimensions 


5.4  Determination  of  the  storage  time  of  the  state  estimate 

Algorithm  FPFD  requires  the  storage  of  the  state  estimate  and  its  covariance  matrix  at  a 
time  tb  <  tT.  Depending  on  the  context  of  the  tracking  application,  different  approaches 
can  be  used  to  determine  the  storage  time  tb  of  the  state  estimate.  For  example,  in  the 
case  where  the  sampling  rate  is  constant,  the  estimate  can  be  stored  in  memory  after  each 
measurement  update  and  up  until  an  anticipated  measurement  update  is  missed  due  to 
a  delay  (of  the  OOSM).  This  would  ensure  that  the  estimate  is  always  stored  at  a  time 
tb  <  tT,  with  tb  =  tT  —  h. 


Last  track  storage 

i 


h 


B 


h 


tr  tk 


Next  track  storage 

i 

i 


L—l  A  i ► A  A  JL 


Figure  5:  Case  where  the  storage  time  tb  of  the  state  estimate  is  determined  according  to 
a  time  interval  of  length  B.  The  state  estimate  and  its  covariance  matrix  are  stored  in 
memory  after  each  time  interval  of  length  B,  where  B  >  h. 

In  a  more  general  case,  the  state  estimate  could  be  stored  in  memory  after  each  time  interval 
of  length  B,  where  B  >  h.  In  that  case  the  storage  time  tb  of  the  state  estimate  changes  after 
each  time  interval  of  length  B ,  as  illustrated  in  Figure  5.  B  corresponds  to  the  maximum 
number  of  lags  lmax  that  are  taken  into  consideration.  Note  that  the  state  estimate  is  not 
stored  at  the  time  of  the  OOSM  tT. 
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The  value  of  B  has  some  influence  on  the  performance  of  algorithm  FPFD.  On  average,  the 
performance  will  deteriorate  as  B  increases.  More  exactly,  the  performance  deteriorates  as 
the  difference  tT  —  increases,  where  we  have 

max(fr  —  tb)  =  B  (51) 

The  deterioration  of  the  performance  for  increasing  tT — B  differences  is  due  to  the  correlation 
between  the  process  noise  and  the  current  state,  as  discussed  in  Section  5.2. 

5.5  Data  association 

Faced  with  the  problem  of  data  association  and  OOSM,  the  most  straightforward  but  costly 
solution  is  to  include  the  OOSM  by  reprocessing  in  chronological  order  all  the  measurements 
that  happened  after  the  OOSM  time.  Besides  its  computational  cost,  this  method  works 
with  any  data  association  algorithm.  With  more  efficient  OOSM  algorithms  that  do  not 
reprocess  the  sequence  of  the  past  measurements,  and  therefore  do  not  store  the  past  mea¬ 
surements,  data  association  becomes  a  more  complicated  problem.  Some  methods  use  the 
probabilistic  data  association  filter  (PDAF)  [10,  24],  but  they  require  some  large  amount  of 
storage  and  processing.  PDAF  could  be  used  jointly  with  the  FPFD  method,  though  this 
will  not  be  investigated  in  this  work.  In  short  the  approach  would  come  down  to  save  all 
tracks  at  tw,  predict  up  to  the  OOSM  time,  compute  the  association  weight  of  the  OOSM 
for  each  track,  update  the  tracks  with  the  OOSM,  predict  the  tracks  up  to  the  current 
time,  fuse  and  decorrelate  the  same  way  as  described  in  equations  (34)  to  (39).  Note  that 
this  method,  that  combines  PDAF  and  FPFD,  would  not  yield  optimal  results  since  PDAF 
normally  requires  the  innovation  for  all  pairs  of  measurements  and  tracks.  Besides  PDAF, 
one  of  the  most  widely  used  multi-target  tracking  and  data  association  approach  is  the 
multiple  hypotheses  tracking  algorithm  (MHT)  [1,  7].  The  combination  of  FPFD  and  MHT 
has  not  been  studied,  and  it  looks  to  be  a  very  challenging  problem.  As  more,  no  solution 
have  been  presented  yet  in  the  literature  that  combines  MHT  and  an  OOSM  algorithm. 
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6  Results  and  discussion 


To  demonstrate  the  performance  of  the  FPFD  method,  the  latter  is  compared  with  the 
retrodiction-based  algorithms  presented  in  [2,  3].  The  results  reported  therein  are  compared 
with  those  yielded  by  the  FPFD  method,  using  the  same  test  scenarios.  First,  a  scenario 
with  a  delayed  measurement  whose  time  stamp  is  within  the  last  sampling  interval  (Example 
2  of  [2])  is  presented.  It  will  be  referred  to  as  the  1-step  lag  scenario.  Afterward,  we  present 
a  multiple-step  lag  scenario  that  is  identical  to  the  one  used  in  [3].  This  scenario  considers 
the  case  of  delayed  measurements  whose  time  stamps  are  within  one  or  more  sampling 
intervals.  Finally,  we  simulate  three  OOSM  scenarios  with  2D  nonlinear  measurement 
model  and  sensor  communication  delays.  The  three  scenarios  are  similar  to  some  of  the 
real-world  examples  presented  in  [3].  In  order  to  preserve  symmetry  of  the  covariance 
matrices,  the  Joseph  form  is  used  for  the  covariance  update  [8].  Also,  the  storage  of  the 
state  estimate  for  algorithm  FPFD  is  made  such  that  ty,  =  tT  —  h.  except  for  the  results 
shown  in  Tables  14  and  15,  where  different  values  of  the  storage  interval  B  are  tested. 

6.1  1-step  lag  scenario 

The  considered  scenario  (from  [2] )  uses  a  discrete-time  dynamical  system  with  three  different 
values  for  the  continuous  time  process  noise  variance  (q  =  0.5,  1,  4).  The  state  equation  is 
given  by 

x (k)  =  q  ^  x{k  —  1)  +  v(k,  k  —  1)  (52) 

where  h  is  the  sampling  interval,  and  where  the  process  noise  v(k,k  —  1)  is  assumed  white 
with  a  zero  mean  and  a  covariance  matrix 

E  v(k,k  -  l)v(k,k  -  1)'  =q  ^  =Q  (53) 

The  measurement  z(k)  of  the  state  x(k)  is  given  by 

z(k)  =  [l  0]  x(k )  +  w(k )  (54) 

where  w(k)  is  white  measurement  noise,  with  a  zero  mean  and  a  covariance  matrix 

E  w(k )2  =  R  =  1.  (55) 

The  estimation  starts  at  time  k  =  1.  with  initial  covariance  matrix 

p(1|1>  =  [r%  2Rm\  ■  <56> 

An  OOSM  with  time  stamp  r  =  1.5  has  to  be  processed  at  time  k  =  2. 

Based  on  the  above-described  scenario,  the  FPFD  method  is  compared  with  the  in-sequence 
measurements  reprocessing  method  (In-seq),  OOSM  discarding,  and  with  the  algorithms3 

3 Algorithm  A  is  also  referred  to  as  the  “Y-algorithm”  in  [10]. 
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A,  B,  and  C  from  [2],  Algorithm  A  is  referred  to  as  the  optimal  retrodiction  algorithm  in 
that  it  accounts  entirely  for  the  process  noise.  Algorithms  B  and  C  are  called  suboptimal 
retrodiction  algorithms  since  they  ignore  the  retrodicted  noise.  Algorithm  C  is  a  simpler 
version  of  algorithm  B.  Furthermore,  the  in-sequence  measurement  reprocessing  method 
is  the  simple  approach  that  reprocesses  all  the  past  measurements  chronologically  starting 
from  the  OOSM  time.  It  provides  the  optimal  solution4).  The  discard  approach  simply 
ignores  the  OOSM. 

1.  Performance  —  As  shown  in  Table  4,  algorithm  A  and  FPFD  are  both  optimal  since 
they  yield  the  same  P{k\k,  r)  as  the  in-sequence  measurements  reprocessing  method. 
This  applies  for  different  values  of  the  process  noise.  Table  5  shows  that  discarding 
the  OOSM  has  a  significant  impact  on  the  track  quality,  since  the  trace  of  P(k\k,r) 
is  6.1%  to  18.4%  higher  than  in  the  case  of  the  optimal  methods. 


Q 


4 


1 


0.5 


In-Seq 


Discard 


FPFD 

A 

B 

C 


6825 

7396 

.7396 

2.5725 

.6248 

.5018 

8636 

6818 

.6818' 

2.5909 

'.8421 

.5526 

6825 

7396 

.7396' 

2.5725 

'.6248 

.5018 

6825 

7396 

.7396' 

2.5725 

'.6248 

.5018 

6826 

7396 

.7396' 

2.5725 

'.6249 

.5018 

7143 

8571 

.8571 ' 
2.3851 

'.6364 

.5455 

.5018 

1.0539 

.6129 

.4526 

.4526 

.7626 

.5526' 

1.0658 

'.8378 

.5270 

.5270' 

.7872 

.5018' 

1.0539 

'.6129 

.4526 

.4526' 

.7626 

.5018' 

1.0539 

'.6129 

.4526 

.4526' 

.7626 

.5018' 

1.0539 

'.6129 

.4526 

.4526' 

.7626 

.5455 ' 
1.0655 

'.6190 

.4762 

.4762' 

.7754 

Table  4:  Covariance  matrices  for  different  process  noise  (1-step  lag  scenario) 


For  further  comparison,  the  actual  Mean  Square  Error  (MSE)  was  also  computed 
through  10000  Monte  Carlo  runs.  The  results  are  summarized  in  Table  6,  where,  as 
a  further  demonstration  of  their  optimality,  the  MSE  of  algorithm  FPFD  and  that  of 
algorithm  A  are  equal  to  the  MSE  yielded  by  in-sequence  measurements  reprocessing. 


4Note  that  algorithm  Zi  presented  in  [25,  17]  also  provides  an  optimal  solution  for  the  general  1-step  lag 
case.  However,  its  storage  requirements  is  high  compared  to  the  other  sub-optimal  OOSM  algorithm  (see 
Table  3) 
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q 

4 

1 

0.5 

In-Seq 

3.2550 

1.6787 

1.3754 

Discard 

3.4545 

(6.1%) 

1.9079 

(13.7%) 

1.6250 

(18.4%) 

FPFD 

3.2550 

(0%) 

1.6787 

(0%) 

1.3754 

(0%) 

A 

3.2550 

(0%) 

1.6787 

(0%) 

1.3754 

(0%) 

B 

3.2551 

(.003%) 

1.6787 

(0%) 

1.3754 

(0%) 

C 

3.0994 

(-4.8%) 

1.7019 

(1.4%) 

1.3944 

(1.4%) 

Table  5:  Trace  of  covariance  matrices  and  relative  deviation  with  respect  to  the 
optimal  (1-step  lag  scenario) 


Q 


4 


1 


0.5 


In-Seq 

'.6895 

.7684 

.7684' 

2.5937 

'.6274 

.5327 

.5327' 

1.1257 

'.6192 

.4704 

.4704' 

.8063 

Discard 

'.8571 

.6988 ' 

'.8494 

.5868 ' 

'.8565 

.5416' 

.6988 

2.6211 

.5868 

1.1389 

.5416 

.8273 

FPFD 

'.6895 

.7684' 

'.6274 

.5327' 

'.6192 

.4704' 

.7684 

2.5937 

.5327 

1.1257 

.4704 

.8063 

A 

'.6895 

.7684' 

'.6274 

.5327' 

'.6192 

.4704' 

.7684 

2.5937 

.5327 

1.1257 

.4704 

.8063 

Table  6:  MSE  for  10000  Monte  Carlo  runs  (1-step  lag  scenario) 
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2.  Cost  —  In  terms  of  track  quality,  the  FPFD  method  was  proved,  based  on  the  above 
results,  to  be  as  optimal  as  method  A.  Algorithms  FPFD  and  A  provided  a  similar 
performance,  both  in  terms  of  MSE  and  estimation  error  covariance  estimation.  For 
the  cost  associated  with  data  storage,  and  for  lmax  =  1,  equations  (47)  to  (49)  lead  to 
identical  requirements  for  algorithms  FPFD  and  A  (i.e.,  n2  +  3n  +  2)  and  less  storage 
requirement  for  algorithm  B  (i.e.,  n2  +  2n  + 2).  The  counterpart  of  this  lower  cost  for 
algorithm  B  is  its  lower  performance  in  terms  of  tracking  quality,  as  shown  in  Tables  4 
to  6. 

6.2  Multiple-step  lag  scenario 

A  dynamic  system,  identical  to  the  one  used  in  [3],  is  considered  with  three  different  OOSM 
lags  /  =  1,2,3.  The  system  behavior  is  similar  to  the  1-step  lag  case,  where  the  dynamics 
are  given  by  (52)  and  (53),  except  that  here  both  position  and  velocity  are  measured.  The 
measurement  equation  is  then 


z(k) 


1 

0 


1  x(k)  +  w(k) 


where  w(k)  has  an  error  covariance  matrix 


R  = 


1 

0 


0 

0.1 


(57) 


(58) 


The  filter  is  initiated  at  to  =  0,  with 


a(0|0)  =  z(  0),  P(0|0)  =  R  (59) 

and  ends  up  at  =  4s.  The  three  OOSM  lags  Z  =  1,2,3  correspond  to  times  r  =  1.5s,  2.5s, 
and  3.5s,  as  illustrated  in  Figure  6. 


z(t ) 

^ i - -  >^o^o  >ll - ► 

to  =  0  l :  3  2  1 

r  :  1.5  2.5  3.5 

Figure  6:  OOSM  with  three  different  lags  Z  =  1,2,3 


The  in-sequence  measurements  reprocessing  method,  algorithm  AZ1,  algorithm5  B/l,  the 
OOSM  discard  solution,  and  algorithm  FPFD  are  all  compared.  Algorithms  A/1  and  B/l 
are  the  /-step  lag  extensions  to  the  1-step  lag  algorithms  A  and  B  presented  in  [2],  respec¬ 
tively.  They  both  use  an  equivalent  measurement  concept  originally  presented  in  [6]. 


SBZ1  is  the  one-step  equivalent  measurement  version  of  the  “M-algorithm”  defined  in  [16]. 
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Lag  1  2 


3 


In-Seq 

'.2287 

.0225 

.0225' 

.0759 

'.2597 

.0381 

.0381' 

.0832 

'.2854 

.0387 

.0387' 

.0833 

FPFD 

'.2287 

.0225' 

'.2563 

.0372' 

'.2906 

.0403' 

.0225 

.0759 

.0372 

.0827 

.0403 

.0827 

A/1 

'.2287 

.0225' 

'.2563 

.0372' 

'.2906 

.0403' 

.0225 

.0759 

.0372 

.0827 

.0403 

.0827 

B/l 

'.2330 

.0254' 

'.2667 

.0389' 

'.2955 

.0403' 

.0254 

.0779 

.0389 

.0830 

.0403 

.0828 

Discard 

'.3142 

.0370 

.0370' 

.0834 

Table  7:  Covariance  matrices  for  different  lag  values  (/- step  lag  scenario),  q  =  0.5 


1.  Performance  —  As  shown  in  Tables  7  and  8,  for  the  /- step  lag  case  (/  >  1),  algo¬ 
rithm  FPFD  has  a  performance  equal  to  algorithm  A/1.  According  to  the  estimated 
covariance  matrix  P(k\k,r),  the  performance  of  algorithm  FPFD  does  degrade  as  the 
number  of  step-lag  increases,  compared  to  the  in-sequence  reprocessing  of  the  mea¬ 
surements.  The  difference  is  represented  in  Table  8,  where  the  trace  of  P(k\k,  r)  is 
presented  for  the  different  algorithms,  along  with  the  trace  relative  deviation  com¬ 
pared  to  the  optimal  in-sequence  measurements  reprocessing.  This  degradation  is 
due  to  the  dependence  issue  between  the  process  noise  and  the  state  (discussed  in 
Chapter  5). 


Lag 

1 

2 

3 

In-Seq 

.3046 

.3429 

.3687 

Discard 

.3976 

(30.5%) 

.3976 

(16.0%) 

.3976 

(7.8%) 

FPFD 

.3046 

(0%) 

.3390 

(-1.1%) 

.3733 

(1.2%) 

A/1 

.3046 

(0%) 

.3390 

(-1.1%) 

.3733 

(1.2%) 

B/l 

.3109 

(2%) 

.3497 

(2%) 

.3783 

(2.6%) 

Table  8:  Trace  of  covariance  matrices  and  relative  deviation  with  respect  to  the 
optimality  (/-step  lag  scenario),  q  =  0.5 


Table  9  presents  the  MSE  of  each  algorithm  for  the  /- step  lag  cases.  MSE  for  algo¬ 
rithms  FPFD  and  A/1  are  close  to  the  MSE  provided  by  the  in-sequence  measurement 
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reprocessing  method.  Algorithm  B/l  is  also  relatively  close  to  the  optimal  method. 
Note  that  the  performance  of  algorithms  A/1  and  B/l  was  discussed  thoroughly  in  [3]. 


Lag  2  3 


In-Seq 

'.2564 

.0371 

.0371' 

.0813 

'.2835 

.0404 

.0404' 

.0845 

Discard 

'.3110 

.0356' 

'.3120 

.0382' 

.0356 

.0814 

.0382 

.0847 

FPFD 

'.2592 

.0380' 

'.2887 

.0408' 

.0380 

.0817 

.0408 

.0848 

A/1 

'.2592 

.0380' 

'.2887 

.0408' 

.0380 

.0817 

.0408 

.0848 

B/l 

'.2613 

.0375' 

'.2894 

.0403' 

.0375 

.0815 

.0403 

.0847 

Table  9:  MSE  for  different  lag  values  (/-step  lag  scenario)  and  for  10000  Monte  Carlo 
runs,  q  =  0.5 

2.  Cost  —  According  to  equations  (47)  to  (49),  the  FPFD  method  has  a  storage  require¬ 
ment  that  is  equal  to  the  one  of  algorithm  A/1  only  for  lmax  =  1  (1-step  lag  situation). 
For  /-step  lag  scenarios,  where  lmax  >  1,  algorithm  FPFD  requires  less  storage  space 
than  algorithm  A/1.  This  is  also  the  case  with  algorithm  B/l.  As  shown  previously, 
algorithm  B/l  requires  less  storage  for  the  1-step  lag  case  (lmax  =  1)-  However,  its 
storage  requirements  are  larger  for  multiple-step  lag  OOSMs  (lmax  >  1). 

6.3  2D  nonlinear  measurement  model  and  sensor  communication 
delays 

The  following  example  is  drawn  from  the  practical  examples  in  [3,  17].  It  aims  at  comparing 
the  FPFD  method  against  other  OOSM  algorithms  when  nonlinear  measurements  conver¬ 
sion  are  considered.  As  in  [3,  17],  a  target  is  tracked  using  two  GMTI  sensors.  The  target 
motion  follows  the  constant  velocity  model  in  two  dimensions  with  process  noise  spectral 
density  q  =  lm2//.  The  two  GMTI  sensors  have  nearly  orthogonal  lines-of-sight  and  both 
have  a  slant  range  of  about  100  km  from  the  target.  Each  sensor  observation  is  in  polar 
coordinates  and  includes  range  (r),  azimuth  (9)  and  range  rate  (r).  The  related  standard 
deviations  are  10  m,  1  mrad  and  1  m/s,  respectively.  Since  the  bias  significance  factor 
is  below  0.4  ( ra‘n/ar  ~  0.001),  the  measurements  are  converted  into  Cartesian  coordinates 
using  the  conventional  coordinate  transformation  [4,  7].  Three  scenarios  are  simulated. 
Scenario  1-SL,  3-SL  and  5-SL  see  sensor  1  have  its  last  measurement  delayed  with  one  lag, 
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Scenario  1-SL 

Sensor  ID 

1 

2 

1 

2 

1 

2 

1 

2 

1 

2 

2 

1 

Time  Stamp  (s) 

0 

2.5 

5 

7.5 

10 

12.5 

15 

17.5 

20 

22.5 

27.5 

25 

Scenario  3-SL 

Sensor  ID 

1 

2 

1 

2 

1 

2 

1 

2 

2 

1 

2 

1 

Time  Stamp  (s) 

0 

2.5 

5 

7.5 

10 

12.5 

15 

17.5 

22.5 

25 

27.5 

20 

Scenario  5-SL 

Sensor  ID 

1 

2 

1 

2 

1 

2 

2 

1 

2 

1 

2 

1 

Time  Stamp  (s) 

0 

2.5 

5 

7.5 

10 

12.5 

17.5 

20 

22.5 

25 

27.5 

15 

Table  10:  Communication  delays  in  a  2  GMTI  radar  network.  1-step  lag  (1-sl),  3-step  lag 
(3-sl)  and  5-step  lag  (5-sl)  OOSM  scenarios. 


Trace  (P) 

Trace(MSE) 

Scenario 

11 

3 1 

51 

11  31  51 

FPFD 

AZ1 

252.39 

252.39 

249.24 

249.24 

253.62 

253.62 

251.63  259.68  260.03 

251.63  259.68  260.03 

Table  11:  Traces  of  the  average  filter  covariance  matrix  (Trace(-P))  and  of  the  actual  MSE 
matrix  (Trace(MSE))  for  the  OOSM  algorithms  AZ1  and  FPFD.  Results  are  obtained  from 
1000  Monte  Carlo  runs 


three  lags  and  five  lags,  respectively.  The  lists  of  the  measurements  sent  to  the  central 
tracker  by  the  two  GMTI  sensors  are  presented  in  Table  10  for  the  three  scenarios.  The 
initial  target  state  is  [70000  m,  70000  m,  60  m/s,  20  m/s\.  Track  initialization  is  made 
according  to  the  two-point  initialization  technique  [5]. 

Table  11  shows  the  trace  of  the  average  filter  covariance  matrix  and  the  trace  of  the  actual 
MSE  matrix  for  the  OOSM  algorithms  AZ1  and  FPFD.  Clearly,  for  the  three  scenarios,  the 
results  are  the  same  whether  algorithm  AZ1  or  algorithm  FPFD  is  used.  Table  12  shows 
the  normalized  estimation  error  squared  (NEES)  [5]  for  the  4-dimensional  state  based  on 
1000  runs.  Both  algorithms  AZ1  and  FPFD  result  in  a  NEES  of  3.87  in  scenario  11,  4.00 
in  scenario  3 1  and  4.14  in  scenario  51.  The  NEES  for  algorithms  AZ1,  B/l  and  FPFD  all 
he  within  the  two-sided  95%  confidence  bounds  based  on  the  xlooo  distribution  (3.8261, 
4.1767)  [5].  Therefore,  algorithms  AZ1,  B/l  and  FPFD  are  statistically  consistent  for  the 
three  scenarios. 

The  aim  of  this  practical  example  is  to  show  that  algorithm  FPFD  has  the  same  perfor¬ 
mance  as  algorithm  AZ1  in  a  practical  OOSM  example  that  involves  nonlinear  measurement 
conversions.  The  results  presented  in  Tables  11  and  12  are  conclusive,  since  the  measured 
performance  of  algorithm  FPFD  is  identical  to  the  measured  performance  of  algorithm  AZ1. 

Moreover,  Table  13  shows  the  CPU  times  of  algorithms  AZ1,  BZ1  and  FPFD  for  1000  Monte 
Carlo  runs.  Although  the  measured  CPU  times  represent  only  imprecise  approximations  of 
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Scenario 

11 

31 

5/ 

In-Seq 

3.87 

3.97 

4.01 

FPFD 

3.87 

4.00 

4.14 

All 

3.87 

4.00 

4.14 

Bll 

3.87 

4.01 

4.08 

Table  12:  Normalized  Estimation  Error  Squared  (NEES)  at  last  update  time  for  differ¬ 
ent  OOSM  algorithms.  1-step  lag  (1-SL),  3-step  lag  (3-SL)  and  5-step  lag  (5-SL)  OOSM 
scenarios.  Results  are  obtained  from  1000  Monte  Carlo  runs. 


Lag 

1 

3 

5 

FPFD 

0.71 

0.67 

0.73 

All 

0.82 

0.84 

0.82 

Bll 

0.75 

0.68 

0.69 

Table  13:  CPU  times  (s)  for  1000  Monte  Carlo  runs 


the  computational  complexity  of  the  algorithms,  they  are  used  here  for  comparison  purposes. 
The  measured  CPU  times  of  algorithm  FPFD  are  comparable  to  those  of  algorithm  B/l, 
which  are  lower  than  those  of  algorithm  A/1  in  all  of  the  three  lag  cases  shown  in  Table  13. 

Finally,  Tables  14  and  15  show  the  performance  of  algorithm  FPFD  according  to  the  storage 
interval  B  defined  in  (51)  and  for  the  1-step  lag  scenario  described  in  Table  10  (Scenario 
1-SL).  The  NEES  obtained  with  algorithm  FPFD  and  shown  in  Table  14  are  3.99,  4.01  and 
4.02  for  B  =  1,  B  =  4  and  B  =  6,  respectively.  Therefore,  the  NEES  increases  slightly  as  B 
augments.  Recall  that  the  corresponding  two-sided  95%  confidence  bounds  for  1000  Monte 
Carlo  are  [3.8261,4.1767].  The  traces  of  the  actual  MSE  matrices  shown  in  Table  15  also 
increase  slightly  as  B  augments,  while  the  traces  of  the  average  filter  covariance  matrices 
decrease  as  B  augments.  Note  that  for  B  >  1  algorithm  FPFD  loses  its  optimality  compared 
to  the  in-sequence  measurements  reprocessing  method.  Hence,  we  have  e  ^  0  in  (45)  when 
B>  1. 


B 

1  4 

6 

FPFD 

3.99  4.01 

4.02 

In-Seq 

3.99 

Table  14:  NEES  for  algorithm  FPFD  at  last  update  time,  for  the  1-step  lag  OOSM  case 
(Scenario  1-SL)  and  in  terms  of  the  storage  interval  B.  Comparison  with  the  In-sequence 
reprocessing  method  (In-Seq)  from  1000  Monte  Carlo  runs. 
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Trace  (P) 

Trace(MSE) 

B 

1  4  6 

1  4  6 

FPFD 

252.3  250.8  250.4 

247.1  247.4  247.9 

In-Seq 

252.3 

247.1 

Table  15:  Traces  of  the  average  filter  covariance  matrix  (Trace(-P))  and  of  the  actual  MSE 
matrix  (Trace(MSE))  for  the  1-step  lag  OOSM  case  (Scenario  1-SL)  and  in  terms  of  the 
storage  interval  B  of  algorithm  FPFD.  Comparison  with  the  in-sequence  measurement 
reprocessing  method  (In-Seq)  from  1000  Monte  Carlo  runs. 


7  Conclusions 


In  the  preceding,  a  forward  prediction  and  decorrelation-based  method  for  processing  out- 
of-sequence  measurements  was  presented.  In  terms  of  track  quality,  the  proposed  FPFD 
method  was  proved  to  be  optimal  for  the  1-step  lag  case.  For  the  multiple-step  lag  case,  the 
method  loses  its  optimality  compared  to  the  in-sequence  measurements  reprocessing  and  to 
the  optimal  solution  presented  in  [25].  Nonetheless,  its  results  are  valuable  since  they  are 
equal  to  those  obtained  with  some  of  the  most  recent  retrodiction  methods  presented  in  the 
literature,  while  requiring  less  data  storage.  Finally,  the  performance  of  the  FPFD  method 
depends  on  the  track  storage  interval  B.  It  was  shown  that  the  performance  deterioration 
is  minor  for  small  values  of  B.  Moreover,  when  the  sampling  rate  is  fixed  so  that  it  is 
known  when  a  measurement  has  not  arrived,  the  time  of  track  storage  can  be  brought  close 
enough  to  the  OOSM  time  such  that  there  is  no  performance  deterioration  due  to  the  track 
storage  time.  In  such  conditions,  the  FPFD  method  can  be  a  valuable  choice  for  practical 
applications. 
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Annex  A:  Dynamics  model 


The  tracked  target  is  assumed  to  be  moving  with  constant  velocity  in  a  2D  space,  where 
the  acceleration  acts  as  an  input6.  Cartesian  coordinates  are  used  in  order  to  be  in  a  linear 
system.  The  state  to  be  estimated  is  composed  of  the  target’s  coordinates,  viz.,  the  position 
and  the  linear  velocity.  With  the  following  state  variable  notation 


x  = 


and 


v  = 


Vl 

V2 


the  equations  of  such  a  target  can  be  expressed  as 

x(k  +  1)  =  F{k,  k  —  l)x(k)  +  ri>(fc) 


(A.l) 


(A.2) 


where  v  is  a  vector  of  random  variables  that  reflects  the  unforeseeable  variation  of  the 
acceleration  in  both  directions.  Note  that  Tv(k)  is  the  same  as  v(k,  k—  1),  which  represents 
the  cumulative  effect  of  the  process  noise  over  the  time  increment  k  —  1  ,k.  The  state 
transition  matrix  is  given  by 


Fk 


1  0  h  O' 
0  10  h 
0  0  10 
0  0  0  1 


(A.3) 


where  h  is  the  time  increment.  The  matrix  T  in  (A.2)  depends  on  the  model  used  to 
represent  the  discrete-time  nature  of  the  process  noise  v.  Two  examples  are  given  below. 
The  first  one 


h2/2  0 

0  h2/ 2 

h  0 

0  h 


represents  to  the  pulse  model,  while  the  following  one 

W  Vh2 


r  = 


2\/3 

0 

0 

0 


2 

0 

Vh 

0 


2s/3 

0 

0 


2 

0 

y/h 


(A.4) 


0  0 


(A. 5) 


“Since  the  acceleration  may  change  unforeseeably,  it  is  often  modeled  as  a  random  variable,  and  so  will 
be  as  such. 
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is  used  by  the  Brownian  motion  modeling.  Note  that  the  latter  requires  four  random 
variables  instead  of  two.  If  the  process  noises  are  assumed  to  have  the  same  standard 
deviation  Sv,  the  pulse  model  results  in  the  following  process  noise  covariance  matrix 


Q 


S^TT1 


\hA 


2 

0 


0 

h4 

T 

o 

h3 

y 


h3 

y  0 

h3 

0  — 

2 

h 2  0 

0  h2 


while  the  covariance  matrix  for  the  Brownian  motion  is  given  by 


Q  =  S2vTTt 

-h3 

y 


2 

0 


0 

h3 

y 

0 

h 2 

y 


h 2 

y 

0 

h 

0 


0 
h 2 

y 

0 

h 


(A.6) 


(A.7) 


(A.8) 


(A.9) 
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Annex  B:  /-step  lag  case  analysis  of  P(k)  and  Pjk)^ 

It  will  be  demonstrated  that  P(k)^  —  P(k)  is  always  positive  definite  for  the  1-step  lag 
cases.  The  results  will  then  be  generalized  to  the  l- step  lag  case. 

B.1  1-step  lag  case 

Let  Pk~2  be  the  error  covariance  matrix  at  one  sampling  interval  before  the  OOSM  time. 
In  the  case  the  measurement  is  available,  we  have: 

P(k  -  I)'1  =  [FP(k  -  2 )Ft  +  alT]-1  +  [4C]"1  (B.l) 

P(A:)-1  =  A+4cr1  (B.2) 

where 

1 

A  =  [[ FFP{k  -  2 )FtFt  +  alFTF1']-1  +  [ajtFCFT]-1] _1  +  a2v T  (B.3) 


In  the  case  where  the  measurement  at  time  k  is  missing,  we  have: 

P^(k  -  I)"1  =  [FP{k  -  2 )Ft  +  alT}-1  (B.4) 

Pipiik)-1  =  B  +  [4C]"1  (B.5) 

where 

B  =  [FFP(k  -  2 )FtFt  +  a2vFrFT  +  a2v T]  _1  (B.6) 

Then  the  difference  between  the  track  estimated  error  covariance  without  a  measurement 
update  at  time  k  (P(fc)^,1)  and  the  track  estimated  error  covariance  with  a  measurement 
update  at  time  k  ( P(k ))  is: 

P(A4  -  P(k)  =  [A  +  4C]"1]  -[B  +  4C]"1]  (B.T) 

P(%,  -  P(k)  =  A  —  B  (B.8) 

since  A  -  B  is  positive  definite,  then  we  have: 

xt(A  —  B)x  >  0  (B.9) 

for  all  nonzero  vectors  x  £  lZn.  Equation  (B.9)  can  be  developed  into 

x7  Ax  —  xtBx  >  0  (B.10) 

xT Ax  >  xT Bx  (B.ll) 

xtA~1x  <  xtB1x  (B.12) 

For  simplicity,  let  A  and  B  be  expressed  as 

A=  [[C]-1  +  [D]-1}-1  +  a2vr  (B.13) 

B  =  [C  +  a2v  T]-1  (B.14) 


DRDC  VatartferTR  2005^185 


33 


where 


C  =  FFP(k  -  2)FtFt  +  a2vFTFT  (B.15) 

D  =  4  C  (B.16) 

Using  (B.13)  and  (B.14)  in  (B.12)  yields 

xT  [[C]_1  +  [.D]-1]_1 x  <  xT [C  +  alT]x  (B.17) 

xT  [[C]-1  +  [-D]-1]  1x  +  x1  a^Tx  <  xTCx  +  x1  a^Tx  (B.18) 

xT  [[C]-1  +  [D]-1}  _1cc  <  xTCx  (B.19) 

xT  [[ C ]_1  +  [.D-1]]  *  >  xTC^1x  (B.20) 

xTC~1x  +  xtD~1x  >  xTC~1x  (B.21) 

xtD~1x  >  0  (B.22) 

This  is  always  true  since  D  1  is  positive  definite.  Therefore,  P{k)^—P{k)  is  always  positive 
definite  for  the  1-step  lag  cases.  On  the  contrary,  the  statement 

xT D  ^x  <  0  (B.23) 


is  always  false.  This  means  that  a  track  that  has  a  1-step  lag  missing  measurement  will 
always  have  poorer  accuracy  compared  to  a  track  that  does  not  miss  the  measurement. 

B.2  General  /-step  lag  case 

Because  the  Kalman  equations  are  recursive,  the  proofs  that  P(k)^  —  P(k)  is  always  positive 
definite  for  the  1-step  lag  cases  can  be  extended  to  the  general  l- step  lag  case.  Consequently, 
in  terms  of  track  accuracy  it  is  always  better  to  include  a  measurement  than  discarding  it. 
Although  its  impact  over  track  accuracy  may  change  depending  on  some  conditions,  such 
as  the  (Jv/ on  ratio  and  the  measurement  age,  there  are  no  conditions  where  it  is  better  to 
discard  a  measurement  when  av,  gr  and  the  sampling  interval  stay  constant  throughout 
the  entire  filtering  duration. 
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